﻿using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;

namespace 新型插件机
{
    class 机械视觉
    {

        public void 两个坐标系的转换(double X原,double Y原,double 角度, out double X,out double Y)
        {
            try
            {
                X = X原;
                Y = Y原;
                if (角度 > 0)
                {
                    X = Math.Cos(角度) * X原 - Math.Sin(角度) * Y原;
                    Y = Math.Cos(角度) * Y原 + Math.Sin(角度) * X原;

                }
                else
                {
                    if (角度 < 0)
                    {

                        X = Math.Cos(角度) * X原 + Math.Sin(角度) * Y原;
                        Y = Math.Cos(角度) * Y原 - Math.Sin(角度) * X原;

                    }
                }
            }
            catch
            {
                X = 0;
                Y = 0;
            }

        



        }

        public void 两个坐标系的转换(double X原, double Y原, double 角度,double 偏移X,double 偏移Y, out double X, out double Y)
        {
            try
            {
                X = X原 + 偏移X;
                Y = Y原 + 偏移Y;
                if (角度 > 0)
                {
                    X = Math.Cos(角度) * X原 - Math.Sin(角度) * Y原+ 偏移X;
                    Y = Math.Cos(角度) * Y原 + Math.Sin(角度) * X原 + 偏移Y;

                }
                else
                {
                    if (角度 < 0)
                    {

                        X = Math.Cos(角度) * X原 + Math.Sin(角度) * Y原 + 偏移X;
                        Y = Math.Cos(角度) * Y原 - Math.Sin(角度) * X原 + 偏移Y;

                    }
                }
            }
            catch
            {
                X = 0;
                Y = 0;
            }





        }





    }
}
